% get grid map
gaocheng_data = load('hanggai.mat');
X = gaocheng_data.X;
Y = gaocheng_data.Y;
H = gaocheng_data.H;
X = X - min(X);
Y = Y - min(Y);

F = scatteredInterpolant(X', Y', H');
tX = 0:20:max(X);
tY = 0:20:max(Y);
[tX, tY] = meshgrid(tX, tY);
tH = F(tX, tY);



